// Código Lectura de Laser y envío de información al PC

//Definición de pines

const int x0 = 2;
const int x1 = 3;
const int x2 = 4;
const int x3 = 5;
const int x4 = 6;
const int x5 = 7;

const int y0 = 8;
const int y1 = 9;
const int y2 = 10;
const int y3 = 11;
const int y4 = 12;
const int y5 = 13;

const int tiempo = 1;
int x=0;
int y=0;

// Definicioón de Bytes de cada eje

byte ejeX = B000000;
byte ejeY = B000000;

int primerX;
int primerY;
int segundoX;
int segundoY;

void setup() {
  // configura pines como entrada digital
  pinMode(x0, INPUT);     
  pinMode(x1, INPUT);
  pinMode(x2, INPUT);
  pinMode(x3, INPUT);
  pinMode(x4, INPUT);
  pinMode(x5, INPUT);
  
  pinMode(y0, INPUT);
  pinMode(y1, INPUT);
  pinMode(y2, INPUT);
  pinMode(y3, INPUT);
  pinMode(y4, INPUT);
  pinMode(y5, INPUT);
  
  Serial.begin(1200);
}

void loop(){
  
// escritura de los bits que componen el Byte X e Y

bitWrite(ejeX,0,digitalRead(x0));
bitWrite(ejeX,1,digitalRead(x1));
bitWrite(ejeX,2,digitalRead(x2));
bitWrite(ejeX,3,digitalRead(x3));
bitWrite(ejeX,4,digitalRead(x4));
//bitWrite(ejeX,5,digitalRead(x5));

//bitWrite(ejeY,0,digitalRead(y0));
//bitWrite(ejeY,1,digitalRead(y1));
//bitWrite(ejeY,2,digitalRead(y2));
//bitWrite(ejeY,3,digitalRead(y3));
//bitWrite(ejeY,4,digitalRead(y4));
//bitWrite(ejeY,5,digitalRead(y5));

primerX = int(ejeX);

x=primerX*10;
y=400;
if(x!=0 && y!=0){
Serial.print(x);
Serial.print("-");
Serial.print(y);
Serial.print("\n");
delay(10);
}


//if(primerX > segundoX){
//Serial.println('R');  //se mueve a la derecha
//}
//else if(primerX < segundoX){
//Serial.println('L');  //se mueve a la izquierda
//}
//else{
//Serial.println('W');  //esta en espera
//}

//if(primerY > segundoY){ 
//Serial.println('D');  //se mueve hacia abajo
//}
//else if(primerY < segundoY){
//Serial.println('U');  //se mueve hacia arriba
//}
//else{
//Serial.println('W');  //esta en espera
//}

}
